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Reservsystem for angivande av kurs och attityd i ett flygplan 
TEKNISKT OMRAdE 

Uppfmningen avser en systemfunktion som ger presentation av kurs och flyglSge (attityd) pS 
indikatorer i flygplan, t.ex. en siktlinjesindikator (SI), vid fel pk viss utrustning for ordinarie 
flyglagespresentation. Systemfunktionen, som pa engelska benamns Attitude and Heading 
Reference System och forkortas AHRS efter initialerna, kompletterar flygplanets ordinarie 
presentation for kurs och flyglage. Denna presentation ska hjalpa piloten att ta sig ur svara 
flyglagen och sedan underiatta hemflygning/landning. 



TEKNIKENS STANDPUNKT 

For att inte tappa attityd- och kurspresentation i ett flygplan vid bortfall av ett ordinarie anvant 
troghetsnavigeringssystem (TNS) kravs ett reservsystem. Vid god sikt kan en pilot flyga 
genom att anvanda horisonten som attitydreferens, dock med stor osakerhet om kursen. I 
daligt vader, i moln och nattetid nar horisonten ej ar synlig kan piloten snabbt bli desorienterad 
och darvid fOrsatta flygplanet och sig sjalv i farliga situationer. 

AHRS-system beraknar, oberoende av ordinarie system, attitydvinklar (tipp och roll) och 
flygriktning (kursen). Ett sadant system presenterar kontinuerligt laget for piloten pa en 
indikator i kabin. Behovet av ett reservsystem for attityd kan vara sa stort att flygplan utan ett 
fungerande sadant inte till&ts att flyga. 

Reservsystem i form av en AHRS apparat fmns tillganglig idag. En sadan innehaller bl a gyron 
som mater lagesforandringar i Upp-, roll- och girled for flygplanet. Den innehSller vidare 
accelerometrar och magnetiska sensorer. Accelerometrama anvands for att etablera ett 
horisontalplan. Magnetsensorema anvands for att Istadkomma en magnetisk nordande. Denna 
typ av AHRS-system i apparatform ar dyrbara enheter och medfor installation av vikt- och 
utrymmeskravande utrustning i flygplanet. For att rada hot pk detta foreslis i denna 
beskrivning en syntetisk AHRS som anvander i flygplanet befintliga givare, vilka normalt inte 
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ar avsedda for AHRS-berakningar och damned delvis med vasentligt samre prestanda. istallet 
for givare av den typ som ingSr i en AHRS-apparat. 

Vinklama beraknas med hjalp av i flygplanet befmtliga givare. Syftet ar att anvSnda befintliga 
vinkelhastighetsgyrosignaler och stolla dessa med berakningar utgSende fran andra 
tillgangliga primSfdata i flygplanet. Vinkelhastighetsgyron anvands normalt i styrsystem och 
har i allmanhet vasentligt storre drift an gyron for navigering. 



BESKRIVNING AV UPPFINNINGEN 

Enligt en aspekt av uppfinningen tillhandahills en metod for att syntetiskt berakna 
rescrvattityd och reservkurs medelst i ett flygplan befintliga data sasom specificerat i 
patentkraven. 

Olika utforandeformer har ut^'ecklats. Vid ett utforande finns flygplanets kurs tillganglig och 
vid ett annat utforande beraknas kursen utifrSn en magnetisk kursgivare. Nar kursen finns 
tillganglig kan berakningama reduceras vasentligt. 

Da kursen ar tillganglig (reservkurs) sker berakningen av attityd genom sammanvagning av 
signalema frSn vinkelhastighetsgyrona i flygplanets styrsystem, information frSn luftdata 
(hojd, fart, anfallsvinkel) samt information om kurs (reservkurs). 

D^i kursen inte ar tillganglig sker berakningen av attityd och kurs enligt ett utforande med 
hjalp av kalmanfilter genom sammanvagning av signalema frin vinkelhastighetsgyrona i 
flygplanets styrsystem, information fr&n luftdata (hojd. fart, anfallsvinkel och 
snedanbllsningsvinkel) samt information frin en i flygplanet befmtlig magnetkursdetektor. 

En fordel med en syntetisk AHRS enligt uppfinningsaspekten ar att den staller sig vasentligt 
billigare an konventionella p& egna givare baserade AHRS-system om befmtliga givare i 
flygplanet kan anvandas. Da frigors utrymme och vikt i flygplanet. 



nCURBESKRIVNING 



Figur 1 visar en schematisk bild over en AHRS-funktion, dar kursen ar tillganglig. 

Figur 2 visar principen for invridning av laget for flygplanet i en siktlinjesindikator. till vanster 
utan invridning och till hoger med invridning. 

Figur 3 visar blockschemat for ett reservsystem for bade attityd och kurs. 

Figur 4 visar i tre bilder flygplanets attityd och kurs samt axlarna i det skrovfasta 
koodinatsystemet (body frame) samt anfallsvinkel och snedanbmsningsvinkel. 

Figur 5 visar hur nollfel och skalfaktorfel slar igenom pa uppmatt varde. 
BESKRIVNING AV UTFORINGSFORMER 

Ett antal utforanden beskrivs i det foljande med stOd av figurerna. Enligt uppfinningen 
tillhandahails metoder for att syntetiskt berakna attityd och kurs medelst i flygplanet befmtliga 
data sasom specificerat i patentkraven. 

Vid ett enklare utfdrande finns flygplanets kurs tillganglig. Vid ett annat utforande beraknas 
kursen, i detta fall utifran en magnetisk kursgivare. 

AHRS-berakning nar kursen ar kand 

For att bestamma flygplanets orientering relativt referenskoordinalsystemet N (navigation 
frame) anvands signalerna frSn de tre skrovfast monterade vinkelhastighetsgyrona 2. 
Vmkelhastighetsgyrona 2 mater vinkelhastigheter omkring de tre kroppsfasta 
koordinataxlama (x, y, z). Vinkelhastighetema brukar normalt ha beteckningen (a^ eller p 
(rotation kring x-axeln). cOy eller q (rotation kring y-axeln) och co^ eller r (rotation kring z- 
axeln). Orienteringen mellan del skrovfasta koordinatsystemet B (body) och N-systemet ges 
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av eulervinklarna 9, (> och \\f. Eftersom kursen ar kand ar dock bara 9 och (j) av intresse. Med 
aniagandet alt N-systemet ar ett inertial system och orienterat sa att dess z-axel ar parailell med 
jordens g-vektor kan man visa att 



9 




co^.cos<t) - C0jSin(t) 


(1) 






(Dj. + tane(C0ySin(j> + a3jC0S<t)) 





Om gyrona 2 vore ideala, begynnelsevardena (^q och 9o felfria och om integrationsmetoden 
som anvands vore exakt kan attitydvinklar erhailas genom att ekv (1) loses. I praktiken ar dock 
inga av dessa forulsattningar uppfyllda, utan sensorfel m.m. gor att losningen divergerar och 
relativt snart blir oanvandbar. 

Sensorfel i form av bl a nollfel, skalfaktorfel, snedmontering och accelerationsinducerade 
drifter utgor de dominerande felkallorna. I planflykt ar nollfelet den felkalla som dominerar 
feltillvaxten. 

Pa grund av sensorofuilkomligheter och osakerhet i begynnelsevarden ger ekvation (1) en 
skattning av roll- och tippvinkelderivator enligt 



(p = 



cOyCos^ - co^ sin4> 
0)^ + taneCcOySin^ + OD^cos$) 



(2) 



Skillnaden mellan forvantade (Pahrs (av AHRS-funktionen beraknade) och "verkliga" cp^^f 
(av luftdata, primardata beraknade) attitydvinklar utgor en skattning av attitydfelet 



Se nedan avseende anv^ndning av A(p. 



(3) 



Attitydvinklarna ges slutligen som 
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(pAHRS = \(yjdt + cpo - lim{A(p) (4) 
dar cpo utgor skattade begynnelsevarden. 



Berakning av cpj-^f 

Vid berakning av Gref anvands formeln 9ref = arcsin (/i/Vj) + (a * cos (t>). h ar en 

hogpassfiltrerad hojdsignal. ar true airspeed. 

Vid berakning av (jj^ef anvands formeln (t>ref = arctan (v^ * (y )/g). 

\j/ ar en hogpassfiltrerad kurs(reservkurs)-signal. 



Nollkorrigering av vinkelhastighetsgyron 

Nollfelen i vinkelhastighetsgyrona 2 ar starkt temperaturberoende. Det kan ta 20-30 minuter 
for gyrona att uppna driftstemperatur. Detta medfor att ett TNS-fel kort efter start skulle kunna 
ge stora nollfel vid fortsatt flygning. Det tar dock en viss tid fran det att gyrona 2 erhaller 
spanning till dess att flygplanet lattar, vilket innebar att en del av temperaturinsvangningen ar 
genomford nar ett flygpass inleds. Dessutom forutsatts att landning kan ske inom kort tid vid 
TNS-fel under start. For att minimera nollfel frSn vinkelhastighetsgyrona 2 utfors en 
nollkorrigering av vinkelhastighetsgyrona med programvara. Detta gar ut pa att CO (p, q och r) 
- signalema frin vinkelhastighetsgyrona 2 jamfors med motsvarande signaler fran TNS, se ekv 
(5), genom en skillnadsbildning i 4a. Skillnaden lagpassfiltreras i ett filter 5 och laggs till 
vinkelhastighetsgyrosignalerna i en skillnadsbildare 4b, varvid signalen coj^ som betecknar de 
nollfelskorrigerade gyrosignalerna erhalls och anvands istallet for co i AHRS-berakningarna. 
Detta sker kontinuerligt sa lange TNS fungerar. Vid ett TNS-fel utnyttjas de sist utforda 
nollkorrigeringama for resten av flygningen. 

















^TNS 











-0rAr5Sin(t)rA^s + COS 07/^5 COS (t)r^5 



(5) 



Ett blockschema over realiseringen av AHRS-funktionen med nollkorrigering av 
vinkelhastighetsgyrona aterges i figur 1. Figuren ger en schematisk bild av AHRS-funktionen. 
Nollkorrigeringen av vinkelhastighetsgyrona utfors av cnheterna innanfor det streckade 
omrSdet D. 

VtnS' 9tNS och (t)xNS hogpassfiltreras for att erhalla ^tNS y ^TNS och ^tnS- Dessa 
anvands i ekv (5). vilken ger co^ns ( Ptns* QtnS' ^TNs) ^ ^^^sta block L ca { p, q, r) som 
erhalls som signaler fran gyrona betcknade med 2 i ett andra block lagpassfiltreras i ett 
lagpassfilter 3 innan skillnadsbildningen sker i 4a. 

Skillnadssignalen mellan Otns ( PtnS' Qtns* rTNs)-signalema och CO ( p, q, r)-signalerna 
lagpassfiltreras med lang tidskonstant i ett lagpassfilter 5, dvs. medelvardesbildas under lang 
tid. Filtrel 5 inilialsatts vid startrotation med en kortare tidskonstant. Efter ett kraftavbrott 
initialsatts filtret 5 momentant. 

I blocket 7 beraknas (p, varefter integrationen enligt ekvation (4) utfors i en integrator 8, till 
vilken begynnelsevillkoren (po fors. I en skillnadsbildare 9a tillfors signalen Acp som dock 
kopplas bort medelst en brytare 9b under vissa omkopplingsvillkor, som t ex nar I7I > Ji^u^ 
samt |(t>| > <t>LIM- Acp-signalen passerar en begransare 9c. Storleken pa utsignalen fran 
begransaren 9c ar beroende av storleken pa A(p-signalen (dvs insignalen till begransare 9c). 
Acp-signalen bildas enligt ekv (3) i en skillnadsbildare 9d till villken fors beraknade (Pahrs - 
attitydvinklar och "verkliga" cpj-ef "^^^'^^^'"^1^ ^^^^ givare (primardata) betecknade med 9e. 

De framraknade vinklarna fran AHRS innehiller trots kompenseringar sma nollfel. Da 
utsignalema anvands for presentation i SI korrigeras detta genom anvandning av i rolled 
och AG i tippled for att vrida in SI bilden tills ett stabilt lage erhallits. Se figur 2, dar linjen H 



symboliserar verklig horisont och dar ett flygplan representeras av R Observera att denna 
invridiiing av Sl-bilden endast sker da man ligger innanfor ovan redovisade granser. 

AHRS-berakning nar aven kursen ska beraknas 

Figur 3 askadliggor schematiskt de moduler som utgor byggblock for en andra variant av cn 
syntetisk AHRS och hur dessa moduler ar sammanlankade for att skapa en reservattityd och 
en reservkurs. 

Figur 3 askadliggor principen for reservsystemet enligt uppfinningsaspekten. Systemet bestar 
av tvi delsystem A och B; det forsta delsystemet A utfor skattning av eventuella fel i uppmatt 
jordmagnetiskt fait och det andra delsystemtet B utfor berakning av reservattityd och kurs. 
Totalt leder detta till fern byggblock, dar en forsta matrutin 10 och ett forsta kalmanfilter 1 1 
utgor byggblocken i det forsta delsystemet A och vidare dar integrationsrutinen (1/s) 20, 
matrutin 21 och ett andra kalmanfilter 22 utgor byggblocken i det andra delsystemet B. 
Med matrutin 10 transformeras uppmatta faltvektorkomponenter i det skrovfasta 
koordinatsystemet, kallat body frame, till ett nordligt, ostligt och vertikalt orienterat 
koordinatsystem, kallat navigation frame. Transformationen sker med hjalp av attityd och kurs 
fran flygplanets troghetsnavigeringssystem, TNS, via ledning 12. De jordmagnetiska 
faltvektorkomponenterna, hamtas fran en i flygplanet befmtlig magnetkursgivare och 
inkommer via ledning 13. I det forsta kalmanfiltret 1 1 skattas sedan felen i 
faltvektorkomponenterna ulifran information om hur komponentema nominellt ska vara 
beskaffade, varefter de skattade vardena lagras i ett minne 14. 

Delsystem A (matrutin 10 och kalmanfilter 1 1) anvands bara da TNS fungerar felfritt. Vid 
eventuellt bortfall av TNS anvands senast mojliga skattning av felen i 

faltvektorkomponenterna, dvs det som finns undanlagrat i minnet 14. Eftersom det i manga 
fall kan vara svart att avgora om TNS fungerar som det ska, bor inte den absolut senaste 
skattningen utnyttjas. For att losa detta ar de skattningar av fel i uppmatt jordmagnetiskt fait 
som anvands minst ett flygpass gammalt, dvs de skattningar som finns lagrade i minnet ar fran 
foregaende fiygpass eller tidigare. 




• 
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Integrationsrutinen 20 far information om vinkeihastigheter, i det har fallet for de tre 
koordinataxlarna x, y och z i body frame. Dessa brukar nomialt ha beteckningen co^^ eller p 
(rotation kring x-axeln), co^ eller q (rotation kiing y-axeln) och co^ eller r (rotation 
kring z-axeln). Informationen hamtas fran styrsystemets vinkelhastighetsgyron och matas via 
ledningen 15 till rutinen 20 som integrerar fram attityd och kurs via en transformationsmatris. 

Den andra matrutinen 21 bestar av en utvecklad variant av den forsta matrutinen 1 1 och 
anvander de fran den forsta matrutinen 1 1 erhSUna devierade faltvektorkomponenterna. 
Dessutom beraknas en roll- och tippvinkel med hjalp av data fran befintliga luftdata och 
befintliga anblSsningsgivare, vilka data inkommer via ledning 16 till matrutinen 21 . Medelst 
det andra kalmanfiltret 22 skattas sedan i forsta hand de attityd- och kursfel som uppstar vid 
integrationen av styrsystemets vinkelhastighetsgyrosignaler. I andra haiid anvands 
kalmanfilter 22 for att skatta nollfelen i vinkelhastighetsgyrosignalerna, dvs nollfelen i p, q, 
och r. 

Den forsta matrutinen 10 

Det jordmagnetiska faltet kan beraknas teoretiskt over hela varlden. For att gora detta anvands 
exempelvis IGRF (International Geomagnetic Reference Field). 

Faltvektom i body frame betecknas har med Bp och faltvektorn i navigation frame med B^. 
Vidare betecknas de tre komponentema av faltvektorn enligt 




^12 ^13 



cf - 



C21 ^23 



(8) 



^31 ^32 ^33 



9(28) 



Transformationsmatrisen beraknas med hjalp av atlityd och kurs, 9, \\f, fran TNS. 
Skillnaden mellan uppmatl och enligt modellen beraknad faltvektor blir 

^N, Uppmait ~ ^N, Beraknad ~ ' ^^B ' (^) 

dar 6 betecknar skillnaden i uppmatt storhet och beraknad, 

Vansterledet i ekv (9) blirutsignal frkn den forsta matnitinen 10 och darmed insignal till 
kalmanfllter 1 1. Vidare utnyttjas hogerledet i ekv (9) i kalmanfiltret 1 1, vilket framgar av 
beskrivningen av funktionen fordet forsta kalmanfiltret 1 1 nedan. 



Det forsta kalmanfiltret 1 1 



Givet tillstandsmodellen 

sd arbetar ett kalmanfllter enligt: 
Tidsuppdatering 

+ 1 = ^k^k 

^k+[ = ^k^k^k-^Qk^ 

dar ^ J ar skattad osakerhet for tillstanden after tidsuppdateringen. 
Matuppdatering 



(10) 



(11) 



X 

P 



+ 

k+ 1 
+ 



+ 



T - T ~* 

^k-i-l^k+ \ ^^k+ \^k+}^k+\ ^Jt+ J 

^Jt + 1 ^it + 1 t^A + 1 ~ + l^Jt + 1 1 
Pi 



(12) 



+ 1 + I + 1 ' 



dar fj^^ J ar skattad osakerhet for tillstanden efter matuppdateringen. 
Felen i faltvektorkomponenterna modelleras enligt 



5B, 




















+ 


k S k 












'^yx '^y '^yz 






55. 








k^ k^y s^^ 







(13) 
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dar b ar nollfel, s ar skalfaktorfel och k ar en korskoppling fran en komponent till en annan 
(tex sa innebar index xy hur y-komponenten paverkar x-komponenten). Dessa 12 fel far 
represeniera tillstSnden i del forsta kalmanfiltrei 1 1 enligt 



och tillstandsekvationema far var och en utseendet 

dar index k betecknar den tidsdiskreta upprakningen i tid. 

I ekv (15) ar wj, ett svagt tidsdiskret processbrus for att modellera en viss drift i felen. Ekv 
(15) medfor att prediklionsmatrisen blir enhetsmatrisen och kovariansnnatrisen for 
processbruset blir enhetsmatrisen multiplicerat med a^, , dar a^ar satt till typiskt en 
hundratusendel (dimensionslost eftersom faltvektorkomponenterna normeras till beloppet I 
innan de utnyttjas). 

Nar det galler matuppdateringen av kalmanfilter 1 1 utnyttjas ekv (9) och matmatrisen far 



Pa grund av omodellerade storningar kommer uppmatt jordmagnetisk faltvektor att deviera 
fran modellen, bade till riktning och belopp. Den enklaste varianten ar att modellera dessa 
storningar som ett konstant vitt matbrus med hjalp av matbruskovariansmatrisen Rk- 
Standardavvikelsen for matbruset for de tre faltvektorkomponentmatningama ar vardera satta 
till typiskt en tiondel (dimensionslost eftersom faltvektorkomponenterna normeras till 
beloppet 1 innan de utnyttjas). 

For att undvika genomslag av daliga matningar utnyttjas ett Chi2-test- Dessutom utnyttjas inte 
matningama av faltvektorkomponenterna om vinkelhastigheterna ar for hoga. Detta har sin 
grund i att diverse tidsfordrojningar slar igenom vid hoga vinkelhastigheter. 




(14) 



utseendet 



<-u (-n <-'i3 <^n^;r ^n^y c^^B^ c^^B^ c^^B^ c^^B.^ c^^B^ c^^B^ c^^B^ 

<-2l ^22 ^23 ^2iBx ^ll^y ^23^^ ^21^.v ''iX^z ^n^z ^22^.. ^23«;t ^23^^ 
^31 ^32 ^33 ^3\^x ^-m^y <^33Sz ^31^^ <^31^7 "^^r^z ^32«x <=3^^x ^IJ^y 



(16) 



Integrationsrutinen 20 



Man kan visa att tidsderivatan av transformationsmatrisen C^blir 

I ekv ( 17) ar Wjg och Wjj^ B:s (Body frame) rotation relativt I (Inertial frame) respektive N:s 
(Navigation frame) relativt I, bada skrivna i matrisform. 

Eftersom det har handlar om reservattityd och reservkurs, dar kraven pa fel i attityd ar av 
storleksordningen 2 grader, samtidigt som elementen i Wjj^ ar av storleksordningen 0.01 

grader, forsummas W^^. Uttrycket i (17) blir d& 

dar ar vinkelhastighetsgyrosignalema fran styrsystemets vinkelhastighetsgyron. 
I princip innebar ekv (18) att man bar nio differentialekvationer. Pa grund av ortogonalitet 
behover endast sex av dessa integreras och de dvriga tre kan beraknas med hjalp av 
kryssprodukten. 



Den andra matrutinen 21 

Den andra matrutinen 21 bestar av en utvecklad variant av den forsta matrutinen 1 1, dar 
utvidgningen bestar av en berakning av roll- och tippvinkel med hjalp av data fran luftdata 
(hojd och fart) och anblasningsgivama (anfallsvinkel och snedanblasningsvinkel). 

I den forsta matrutinen 21 antas att endast faltvektorkomponentema ar felaktiga och att attityd 
och kurs ar korrekta. Delta antagande ar rimligt pa grund av att en resolvering av 
faltvektorkomponentema sker med hjalp av attityd och kurs fran TNS. 1 den andra matrutinen 
21 ar delta inte uppfyllt, utan hansyn maste aven tas till fel i attityd och kurs. Faltvektorn som 
anvands i den andra matrutinen 21 ar kompenserad for fel skattade i delsystem A. 

Fel i b4de faltvektorn och transformationsmatrisen ger att 

^N, Uppmatt - ' ^B, Uppmatt ' ^^^^ 
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dar Cb star for beraknad transformationsmatris och betyder att 

^B = C^+6C^. (20) 
Uinyttjar vi (20), bildar sldllnaden mellan uppmatt och beraknad faliveklor och forsummar 
produkter av fel fas att 

^N, Uppmatt " ^N, BeraJcnad ^C^ • B Uppmail **" ' B ' ' ) 

I den andra matrutinen 21 sker aven berakning av roll- och tippvinkel med hjalp av hojd, fart, 
anfallsvinkel och snedanblasningsvinkel. Tippvinkein kan beraknas eniigt 

e^ef = asinf^J^ + cos((t))a + sin(<t>)[5 (22) 

For att kunna berakna tippvinkein eniigt uttrycket i ekv (22) kxavs en hojdderivata. Denna 
hojdderivata ar inte direkt tillganglig, utan den far beraknas utifran befintlig hojd som erhalls 
frSn luftdata. Berakningen gors eniigt 

h = hin) = i(^(^T-lj./i(«-l)H-/2(n)-/i(n-l)j, (23) 

dvs en hogpassfiltrering av hojden. Beteckningama x och i ekv (23) representerar 
filtreringens tidskonstant respektive sampelfrekvens. Farten v som anvands i ekv (22) ar 
approximativt (sann fart relativt luften). Med approximativt menas att vid berakningen av 
V, anvands inte uppmatt temperatur, vilket ar det normala, utan har utnyttjas en sk 
standardtemperaturfordelning. 

Vidare sa kan rollvinkeln beraknas eniigt 

= atan^. (24) 

Uttrycket i ekv (24) galler endast for sma roll- och tippvinklar, sma vinkelhastigheter och 
dessutom alt anfalls- och snedanblasningsvinkiarna ar sma. 



Ovanstaende tv& uttryck beraknas och jamfors med den attityd som beraknas via 
integrationsrutinen genom att skillnaden bildas eniigt 



^ - (|)^^,. = aian — - atan 2^2, 

^33 5(^11+^2,) 

e - e,e, = atan-^ - (asin(^) -h cos(atan|-^)a sin[atan|^Jp 
a/I -C31 



dar 



V = 



*/l-<^31 
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(25) 



C32 

d) = atan — 
C33 

-C31 

9 = gran — " (26) 



Det andra kalmanfiltret 22 



Det andra kalmanfiltret 22 kan sagas vara hjartat i systemet. Har skattas de attityd- och kursfel 
som uppstar vid integrationen av vinkelhastighetsgyrosignalema frSn styrsystemet. Skattning 
sker aven av nollfelen i vinkelhastighetsgyrosignalema. Vidare skattas eventuella Sterstaende 
fel i faltvektorkomponenterna, dvs de fel som det forsta kalmanfiltret 1 1 inte kommer at. Allt 
som allt innebar delta nio tillstand; tre for attityd- och kursfel, tre for nollfelen i 
vinkelhastighetsgyrosignalema och tre for &terstdende fel i faltvektorkomponenterna (tre 
noUfel). 

Attityd- och kursfel representeras med en vridning av det skrovfasta systemet (body frame) 
fran beraknat till sant koordinatsystem. Felet i Cb kan skrivas som 



5cg = c^c^: = c^c«-c^ = c^.(c^-/) 

Man kan overtyga sig om att 



(27) 



1 -yz yy 
y, 1 -yx 
-yy y 



1 



= r + / , 



(28) 



14(28) 



dar r ar matrisformen av y = [ Y;^., Y^., Y^J^och I ar enhetsmatrisen (T 

betecknartransponat). Elementen i vektorn ybeskriver en liten rotation kring respeklive axel 
mellan verkligt (sant) och beraknat skrovfast system (body frame). Motsvarande 
differentialekvationer for elementen i Y harledas till 

Y=5co, (29) 

dar 5co ar felen i vinkelhastigheterna fran vinkelhastighetsgyrona. 

Felen i vinkelhastigheterna, modelleras som tre 1 :a ordningens Markovprocesser enligt 

5ca = — ^-5co + w,.> (30) 

dar tidskonstanten ar satt till typiskt ett antal timmar och de tre till typiskt mindre 

an en grad/sek. 

Pa ett liknande satt ar aterstaende fel i faltvektorkomponenterna modellerade (nollfelen), dvs 
B = -Lb-^u. (31) 

dar ar satt till typiskt ett antal timmar, och«^ och ar satt till typiskt ett par hundradelar 
(dimensionslost eftersom faltvektorkomponenterna normeras till beloppet 1 innan de 
utnyttjas). 

Detta ger en tillstandsvektor enligt 

= [t;, 1y 5co^ 6cOy 5co, by (32) 
och en prediktionsmatris enligt 

F^ = 1+ J A(x)dT: , (33) 

dar A(t) ar den matris som beskriver de tidskontinuerliga tillstandsekvationema enligt ovan. 
Kovariansmatrisen for processbaiset Qj^ ar satt till en diagonalmatris. Som diagonalelement 
utnyttjas bla och beskrivna ovan. Nar det galler diagonalelementen kopplade till 
tillstanden for attityd- och kursfel (de tre forsta) tas effektema av skalfaktorfelen i 
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vin 



kelhastighetsgyrosignalerna med. Dessa skalfaktorfel ar normalt i storleksordningen 2% 
och kan ge stora fel i framintegrerad attityd och kurs vid hoga vinkelhastigheter. 



Matningarna ar fern till antalet; tre devierade faltvektorkomponenter och roll- och tippvinkel 
beraknade utifrSn luftdata. Dessa matningar erhalls genom att relationema (21) och (25) 
utnyttjas. 

Nar det gailer matmatrisen Hi,, utnyttjas relation (21) for att fylla de tre oversta radema. Detta 
ger att de tre oversta radema i matmatrisen far utseendet 



1-3 



(34) 



C,3fiy-Ci2S, C,,B,-C,35, c,2B,-c„B^ 0 0 0 C„ C,2 C,3 

C2^B^-C22B, C2,B^-c^^B, c^2B,-c^,By 0 0 0 Cj, c^, c^^ 

C.^B^. - C3,B, - C33B^ Cj^B, - C^.By 0 0 0 63, C3, C33 

Till de tva sista radema i utnyttjas ekv (25) genom att de bida hogerleden differentieras 
med avseende pa alia tillstand i det andra kalmanfiltret 22. Detta ger att de bida sista raderna 
far elementen (indexet betecknar rad och kolumn i namnd ordning) 



'41 



= 1 - 



g^ic]^ + C2, )^ + V^(C33 ■ O), + C32 ■ (Hy) 

2vj?(- c, , - C21 ^^aX^aat^z + ^32t^>) - ^Sdi.'^zii'^n + <^lO <^32_ 



/142 = 



/143 = 



5^(Ci , + C2,)' + V^(C33 • CO, + C32 • (Oy) 



2 2 



C32 + C33 



2vg(Ci,Ci2 + C21<^22)(<^33«z + CjztO ^) + ^gtO^<^31 ('^1 1 + ^21 > _ ^31 '^33 

^ 2 2 

"33 



1 + C^i )^ + V^(C33 • OD, + C32 • (OyY 

vgC22(cn + C21) 



(35) 



^45 = — 



«^(<^n + 4i f + ^'(^^33 - <^z + ^32 - t^>)" 

2 2 

V?C33(C,, +C2,) 



2 2 



^46 = 



/(Cu + + v'(C33 ■ £0, + C32 • CO,) 



2 2 



och 
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/i^j = sin^atan^^a- cos^atan^Jp 



C33 

'52 - / 2" 



^53 = - 



Ovriga element i fjarde och femte raden ar noli. 

Kovariansmatrisen for matbruset valjs enklast till en diagonalmatris. De fyra forsta 
matbruselementen bar en standardavvikelse som ar satta till typiskt en tiondel. Det femte 
matbruselementet daremot bar en standardavvikelse som ar satt till en funktion av 
bojdderivatan och farten. Funktionen ar belt enkelt en skalad summa av uttrycket for 
berakning av tippvinkel enligt ekv (25) differentierat med avseende pa bojdderivatan ocb 
farten. Funktionen ar satt till 



fifi. v) = 5 



50 



dv 



(37) 



^ref 

och ger ett matt pa tippvinkelberakningens kanslighet for fel i bojdderivatan och farten. 
Eftersom felen i attityd ocb kurs beraknade med hjalp av integrationsrutinen snabbt vaxer, 
maste skattade attityd- och kursfel aterkopplaii tillbaka till integrationsrutinen, vilket utfors 
med ledning 17. Gors inte detta blir felekvationema i det andra kalmanfilteret 22 snabbt 
ogiltiga pa grund av att ekvationerna i grund och botten ar olinjara. Dessutpm aterkopplas 
skattningama av nollfelen i vinkelhastighetsgyrosignalema via en ledning 18. Detta medfor en 
battre linjarisering av det andra kalmanfiltret 22 och dessutom kan sampelfrekvensen 
hallas nere. 

I en del flygsituationer ar de berakningar som utfors i den andra matrutinen 21 undermaliga, 
antingen pS grund av att matekvationerna ej ar tillrackligt anpassade eller att matdata i sig ar 
for bristfalliga, Berakningen av rollvinkeln utifran luftdata anvSnds bara under planflykt. 
Ingen matning utnyttjas om vinkelhastigheterna inte ar tillrackligt sma, typiskt nagon grad/ 
sek. Desutom sker en kontroll av matresidualerna, dar matresidualerna inte tillats overstiga 
typiskt en till tva ganger tillhorande skattad osakerhet. 
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Beteckningar 



Koordinatsystem 



I (Inertial frame): ett i troghetsrymden fixt system. 

Vid flygning ovanfor jordytan ar del brukligt att delta systems centrum sammanfaller med 
jordens centmm. Detta ar egentligen en approximation eftersom ett system fixt i 
troghetsrymden inte far rotera. Pga att jorden roterar runt solcn kommer aven I-systemet att 
rotera. Felet som uppkommer ar emellertid forsumbart. De accelerationer och 
vinkelhastigheter som sensorerna i ett troghetsnavigeringssystem mater ar relativt detta 



N (Navigation frame): ett system med centrum i flygplanet och med xy-planet hela tiden 
parallellt med jordytan. 

x-axeln pekar mot norr, y-axeln mot oster och z-axeln vertikalt nedat mot jordytan. 
B (Body frame): ett i flygplanet skrovfast system. 

Detta koordinatsystem roterar med flygplanet. x-axeln pekar ut genom nosen, y-axeln ut 
genom hogra vingen och z-axeln vertikalt nedat relativt flygplanet. 

Tabell 1 Forklaring av beteckningar for vinklar och vinkelhastigheter. Se 
ocksa figur 4. 




system. 



Vinkeln mellan och horisontalplanet lutat med vin- 
keln e utmed (rollvinkeln). 





Begynnelsevarde for rollvinkeln respektive skattad roll- 
vinkel 



Rollvinkeln beraknad med hjiilp av data fran Iftdata och 
kursderivatan 



Vinkeln mellan jc^ och horisontalplanet (tippvinkeln). 




Begynnelsevarde for tippvinkeln respektive skattad tipp- 
vinkel 



ref 



Tippvinkeln beraknad med hjalp av data fran luftdata och 
anbiasningsgivama 



(p = [<t>, e]^ 



Komprimerad beteckning av rollvinkeln och tippvinkeln 
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Tabell 1 Forklaring av beteckningar for vinklar och vinkelhastigheter. Se 
ocksa figur 4. 



(p, (pQ, Acp 




Ql-i^rtaH mil- rsnh tirinvinVpl sikattaHf hepvnnpl^ievarden 

for roll- och lippvinkeln respektive skillnaden mellan 
framintegrerad och refe re ns beraknad roll- och tippvinkel 


9rcf> tPAHRS 




I? rill- r^nh tinnvinlrpln hpriikn;!^? mpd hifiln av liiftdata 
och primardata respektive framintegrerad roll- och tipp- 
vinkel dar integrationen sker med hjalp av vinkelhastig- 
hetsgyrosignalema 




1 




Vinkeln mellan projektionen av i horisontalplanet 
och norr (kursvinkein) respektive tidsdiskret indexering 
av kursvinkein 


a 






Vinkeln mellan luftrelaterad hastighetsvektor projicerad 
pa 2-axeln i body frame respektive projicerad pa x-axeln i 
body frame (anfalls-vinkeln) 


P 






Vinkeln mellan luftrelaterad hastighetsvektor och luftrela- 
(snedanblasnings vinkeln) 








1 ransionTiaiionsmaLri& yj a j iiiciLija^ duiu Liaii>i*jiiiiciai 
en vektor fran body frame (verkligt) till navigation frame. 
Elementen i denna matris betecknas c^ j, Cj2, C13, C21, C22, 
^23» ^31» ^32' ^33 indexen betecknar rad och kolumn i 
namnd nrdninp 






— 

Cr 


Transformationsmatris som transformerar en vektor fran 
body frame (beraknat) till navigation frame 








Skillnad mellan beraknad och sann 


Y = 






Vridning kring x-, y- respektive z-axeln i body frame 
motsvarande felet mellan sant och beraknat body frame 


r 






Antisymmetriska matrisformen av vektom y 




= CO = ((O^, 




Vinkelhastighet kring x-, y- respektive z-axeln i body 
frame (vinkelhastighetsgyrosignalema). Dessa vinkel- 
hastighetskomponenter brukar ocksS betecknas med 








Vektom co^^ uttryckt i antisymmetrisk matrisform 


5(0 : 


= (Sco^, 6cOy, 5(0^)^ 


Skillnad mellan verklig och uppmatt vinkelhastighet 
kring x-, y- respektive z-axeln i body frame 



y/^^ Rotationen av navigation frame relativt inertial frame som 

uppstar vid forflyttning over den krokta jordytan. Anti- 
symmetrisk matrisform 
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Tabell 2 Forklaring av beteckningar for jordmagnetiska faltet. 

B ^ B^, Jordmagnetiska faltvektorkomponenterna i body frame 

65 , 55 55, Skillnaden mellan uppmatta och verkliga faltvektor- 

■"^ ^ komponenter i body frame 

Jordmagnetiska faltvektorn i navigation frame respek- 
tive body frame 



Tabell 3 Forklaring av beteckningar som anvands i samband med filter 


k,k+\ 


Anvands som index och representerar tidpunkten 
fore respektive efter tidsuppdatering 


n,n+\ 


Anvands for att representera nuvarande respektive 
efterfoljande sampel 


-, + 


Anvands som index och representerar tidpunkten 
fore respektive efter matuppdatering 


X, z,P 


Till stands vektorn, matvektom respektive skatt- 
ningsosakerhetsmatrisen 


Q 


Processbrusvektom respektive kovariansmatrisen 
for processbruset 


A,F 


Prediktionsmatrisen i tidskontinuerlig respektive 
tidsdiskret form 


K,H,R 


Kalmanforstarkningsmatrisen, matmatrisen respek- 
tive kovariansmatrisen for matbruset 


"to' "b' "s 


Drivande brus for markovprocessema 




Tidskonstanter 




Sampelfrekvens 



Tabell 4 Forklaring av ovriga beteckningar. Se ocksa figur 5. 
h h b Bias (nollfel) 



Skalfaktorfel 



fc k ,k yk ,k KorskoppHngsfel (exempelvis star index xy for hur y - 

xr yx^ yv z zy j^omponenten paverkar x-komponenten). Uppkommer 

pga att axlarna i en triad i verkligheten inte ar ortogonala 
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Tabell 4 Forklaring av ovriga beteckningar. Se ocksa figur 5. 



/i, h 


Hojd respektive lagpassfiltrerad tidsderiverad hojd 




Verklig fart relativt luften 


H 


Gravitationen 
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PATENTKRAV 

1 Metod for att syntetiskl berakna reservattityd for ett Hygplan nar flygplanets kurs ar 

kand med hjalp av i flygplanet befintliga data, sasom vinkelhastigheiema p, q, r kring ett 
skrovfast koordinatsystems (body frame) x-, y- och z- koordinater , luftdatainformation i form 
av fart, hojd och anfallsvinkel samt kursinformation, kannetecknad av att metoden innefattar 
stegen: 

- attityden beraknas med utglngspunkt frin de skrovfasta vinkelhastigheterna p, q, r och 

- den beraknade attityden korrigcras mcdelst luftdata och kurs. 

2. Metod enligt patentkrav 1 , kannetecknad av att kursinformationen erhalls fran ett 
kursgyro. 

3. Metod enligt patentkrav 1 eller 2, kannetecknad av att attityd integreras fram via 
information om flygplanets skrovfasta vinkelhastigheter (p, q och r) erhallna ur flygplanets 
skrovfasta vinkelhastighetsgyron. 

4. Metod enligt patentkrav 3 , kannetecknad av att korrigering av framintegrerad 
attityd sker med hjalp av attityd beraknad utifrin luftdatainformationen samt kursinformation. 

5. Metod fdr att syntetiskt berakna reservattityd och reservkurs for ett flygplan med 
hjalp av i flygplanet befintliga data, sdsom vinkelhastigheterna p, q och r kring ett skrovfast 
koordinatsystems (body frame) x-, y- och z- koordinater och luftdatainformation i form av 
fart, hojd och anfallsvinkel. kannetecknad av att metoden innefattar stegen: 

- attityd och kurs beraknas med utgingspunkt fran de skrovfasta vinkelhastigheterna p, q och r, 

- felen i de uppmatta skrovfasta magnetiska faltvektorkomponentema skattas, 

- de uppmatta skrovfasta magnetiska faltvektorkomponentema devieras, 

- fel i beraknad attityd och kurs skattas med hjalp av luftdata samt devierade uppmatta 
skrovfasta magneti ska f altvektorkomponenter och 

- den beraknade attityden och kursen korrigeras med skattade fel i attityd och kurs. 
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6. Metod enligt patentkrav 5. kannetecknad av att attityd och kurs integreras fram via 
information om flygplanets skrovfasta vinkelhastighcter (p, q och r) erhallna ur flygplanets 
skrovfasta vinkelhastighetsgyron. 

7. Metod enligt patentkrav 5, kannetecknad av att skattning av fel 1 uppmatta 
skrovfasta magnetiska faltvektorkomponenter utfors i ett forsta filter (1 1). 

8. Metod enligt patentkrav 6 eller 7, kannetecknad av att i ett andra filter (22) utfors 
skattning av attitydfel och kursfel som uppkommer vid integration av flygplanets skrovfasta 
vinkelhastigheter (p, q och r) erhSllna ur flygplanets skrovfasta vinkelhastighetsgyron, dar 
skattningen gors med hjalp av attityd beraknad fran luftdatainformation samt devierade 
uppmatta skrovfasta magnetiska faltvektorkomponenter. 

9. Metod enligt patentkrav 7 eller 8. kannetecknad av att filtreringen sker med hjalp av 
kalmanfjlter. 

1 0. Anordning f6r att syntetiskt berakna reservattityd f6r ett flygplan nar flygplanets kurs 
ar kand med hjalp av i flygplanet befmtliga data sasom flygplanets skrovfasta 
vinkelhastigheter (p. q och r), luftdata innefattande atminstone fart, hojd och anfallsvinkel 
samt kursinformation, kannetecknad av att anordningen innefattar en integrationsrutin (8) 
for att integrera fram flygplanets attityd ur information om flygplanets skrovfasta 
vinkelhastigheter (p, q och r) samt att den beraknade attityden korrigeras medelst 
referensattityd ur luftdata och reservkurs. 

1 1 . Anordning enligt patentkrav 10, kannetecknad av att kursinformationen erhalls fran 
ett kursgyro. 

1 2. Anordning enligt patentkrav 10 eller 1 1 , kannetecknad av att integration srutinen (8) 
integrerar fram flygplanets attityd ur flygplanets skrovfasta vinkelhastigheter (p, q och r) 
erhillna fran flygplanets skrovfasta vinkelhastighetsgyron. 

13. Anordning enligt patentkrav 12. kannetecknad av att integrationrutinen (8) matas 
med nollfelskompenserade skrovfasta vinkelhastighetsgyrosignaler. 
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14. Anordning enligt patentkrav 10. kannetecknad av att man med luftdatainformation 
samt reservkursinformation beraknar en refercnsattityd. 

15. Anordning enligt patentkrav 10, kannetecknad av att en syntetiskt genererad 
korrigerad attityd erhSHes genom att en skillnad bildas mellan den ur integrationsrutinen (8) 
erhallna altityden och en felsignal som representerar felet mellan den integrerade attityden och 
referensattityden. 

1 6. Anordning for att syntetiskt berakna reservattityd och reservkurs for ett flygplan med 
hjalp av i flygplanet befintliga data, sasom uppmatta skrovfasta magnetiska 
faltvektorkomponenter, flygplanets skrovfasta vinkelhastigheter p, q och r samt luftdata 
innefattande itminstone fart, hojd och anfallsvinkel. kannetecknad av att anordningen 
innefattar en forsta matrutin (10) som transformerar de uppmatta skrovfasta magnetiska 
faltvektorkomponentema till flygplanets navigeringssystem (navigation frame), ett forsta filter 
(11) som skattar felen i de beraknade uppmatta skrovfasta magnetiska 
faltvektorkomponentema, en integrationsrutin (20) for att integrera fram flygplanets attityd 
och kurs ur information om flygplanets skrovfasta vinkelhastigheter (p, q och r), ett andra filter 
(22) for skattning av felen uppkomna i attityd och kurs erhallna vid namnda integration och en 
andra matrutin (21) for berakning av attityd och kurs ur luftdata och devierade uppmatta 
skrovfasta magnetiska faltvektorkomponenter. 

17. Anordning enligt patentkrav 16, kannetecknad av att den forsta matrutinen (10) 
matas med de uppmatta skrovfasta magnetiska faltvektorkomponentema samt attityd och kurs 
fran flygplanets ordinarie navigeringssystem och transformerar de uppmatta skrovfasta 
magnetiska faltvektorkomponentema till flygplanets navigation frame. 

18. Anordning enligt patentkrav 17. kannetecknad av att det fOrsta filtret (11) matas med 
information fran den forsta matrutinen (10) och skattar felen i de uppmatta skrovfasta 
magnetiska faltvektorkomponentema. 



19. Anordning enligt patentkrav 1 6, kannetecknad av att integrationsrutinen (20) 
integrerar fram flygplanets attityd och kurs ur flygplanets skrovfasta vinkelhastigheter (p, q 
och r) erhailna frin flygplanets skrovfasta vinkelhastighetsgyron. 

20. Anordning enligt patentkrav 1 6. kannetecknad av att den andra matrutinen (2 1 ) 
matas med luftdata, de devierade uppmatta skrovfasta magnetiska faltvektorkomponenterna 
och med information om flygplanets skrovfasta vinkelhastigheter (p, q och r) och ur dessa 
varden beraknar en attityd och kurs. 

21. Anordning enligt patentkrav 20, kannetecknad av att det andra filtret (22) matas 
med information fran den andra matrutinen (21) och skattar felen i attityd och kurs samt 
nollfel i skrovfasta vinkelhastighetsgyrosignaler och aterstaende fel i de uppmatta skrovfasta 
magnetiska faltvektorkomponenterna for generering av en felsignal. 

22. Anordning enligt patentkrav 2 1 , kannetecknad av att en syntetiskt genererad 
korrigerad attityd och kurs erhalles genom att en skillnad bildas mellan 

- den ur integrationsrutinen (20) erh^llna attityden och kursen och 

- felsignalen fr5n det andra filtret (22). 

23. Anordning enligt patentkrav 19, kannetecknad av att integrationrutinen (20) matas 
med skrovfasta vinkelhastighetsgyrosignaler kompenserade for skattade nollfel . 



24. Anordning enligt nagot av patentkraven 1 6 - 23, kannetecknad av att det forsta filtret 
(11) och/eller det andra filtret (22) utgors av ett kalmanfilter. 



SAMMANDRAG 



En metod och en anordning for att synietiskt berakna reservattityd och reservkurs medelst i ett 
flygplan befintliga data. Vid ett utforande finns flygplanets kurs tillganglig och vid eit annat 
utforande beraknas kursen utifran en magnetisk kursgivare. Da kursen ar tillganglig 
(reservkurs) sker berakningen av attityd genom sammanvagning av signalema fran 
vinkelhastighetsgyrona (2) i flygplanets styrsystem, information fran lufldata (hojd, fart, 
anfallsvinkel) samt information om kurs (reservkurs). Da kursen inte ar tillganglig sker 
berakningen av attityd och kurs enligt ett utforande med hjalp av kalmanfilter (11 , 22) genom 
sammanvagning av signalema frin vinkelhastighetsgyrona i flygplanets styrsystem. 
information fran luftdata (hojd, fart, anfallsvinkel och snedanblasningsvinkel) samt 
information fran en i flygplanet befmtlig magnetkursdetektor. (Fig. 3). 
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Fig. 3 
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